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acorn 33 of the position command comes to predetermined acceleration threshold ctth 38 
or less, the collision detecting threshold xvth 35 is not returned to the collision detecting 
threshold xth adjusted in the usual operation, but the collision detecting threshold xvth 35 
may be kept xth + dxth for the predetermined time Td 37 as shown in Fig. 2L 

This example will be described with reference to Fig. 21 . In Fig. 21, for a period 
of the time 0.6 to the time 0.8 when the torch pull-up operation is being performed, the 
absolute value of the acceleration component(acomp3 of the position command exceeds 
the predetermined acceleration threshold ath 38. Therefore, for this period, the collision 
detecting threshold xvth 35 becomes greater by dxth 36 than that in the usual case as shown 
in the Numerical Expression 6. When the absolute value of the acceleration component 
acorn 33 of the position command becomes higher than the predetermined acceleration 
threshold ath 38 once, and next becomes lower (at the time 0.8 in Fig. 21), the collision 
detecting threshold xvth 35 is kept xth + dxth for the predetermined time Td 37. 

Thus, even in case that the absolute value of the acceleration component acorn 33 
of the position command exceeds the predetermined acceleration threshold ath 38 and 
thereafter becomes lower than the acceleration threshold ath 38, the value of the collision 
detecting threshold xvth 35 is not returned to the collision detecting threshold xth 
immediately, but is kept xth + dxth for the predetermined time Td 37. Hereby, it is 
possible to prevent the erroneous detection of collision even in case that delay in phase by 
the vibration due to the spring component of the reduction gear and the continuous 
vibration are produced. 

Further, the processing of keeping the value of the collision detecting threshold 
xvth at 35xth + dxth for the predetermined time Td 37 is performed by, for example, a 
program stored in CPU (Central Processing Unit) provided in the robot system. 

Further, the embodiment has been described on the basis on the kinetic calculation 
method. However, the method in the embodiment can be applied also to the disturbance 
estimating observer shown in Fig. 18 

As described above, in case that the welding torch pulling-up operation that is 
larger than the usual operation in acceleration component is performed, the collision 
detecting threshold is made greater than the threshold adjusted in the usual operation, 
whereby the erroneous detection of collision can be prevented. Further, in case that the 
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dxth is an increase of the threshold corresponding to spring vibration of the reduction gear. 

Further, the above xth is previously found on the basis of the usual operation 
executed actually, and the dxth is previously found on the basis of the unusual operation 
executed actually. 



collision judging block 31 by means of this collision detecting threshold xvth 35. In Fig. 
20, as an example of the unusual operation, a welding torch pulling-up operation by a robot 
is shown. 

As shown in Fig. 20, for a period of the time 0.6 to the time 0.8 when the torch 
pull-up operation is being performed, the absolute value of the acceleration component 
acorn 33 of the position command exceeds a predetermined acceleration threshold ath 38. 
Therefore, for this period, as shown by the Numerical Expression 11, the collision 
detecting threshold xvth 35 becomes greater by dxth 36 than the collision detecting 
threshold xth adjusted in the usual operation. Hereby, even in case that the vibration error 
of the reduction gear spring is added to the collision torque estimation value xdiso 28 in the 
period of the time 0.6 to the time 0.8, its absolute value does not exceed the collision 
detecting threshold xvth 35. Therefore, the erroneous detection of collision is not 
generated. 

Further, after the time 0.8, the absolute value of the acceleration component acorn 
33 of the position command comes to the predetermined acceleration threshold ath 38 or 
less. Therefore, the collision detecting threshold xvth 35 returns to the collision detecting 
threshold xth adjusted in the usual operation, whereby the collision detecting sensibility in 
the usual operation time does not lower. 

The judgment of the above threshold and the change of the same are performed by, 
for example, a program stored in CPU (Central Processing Unit) included in a robot 
system. 

In the above description, the example in which the collision detecting threshold 
xvth 35 is returned to the collision detecting threshold xth adjusted in the usual operation 
immediately when the absolute value of the acceleration component acorn 33 of the 
position command comes to predetermined acceleration threshold ath 38 or less has been 
indicated. However, immediately when the absolute value of the acceleration component 




;. 20 shows a waveform when the collision judgment has been performed in a 



29 



T|J. 1 5 : Kinetic friction torque 

xdyn 14 : Kinetic torque (sum of gravitational torque, inertial force, centrifugal 
force and Coriolis force) 

xdis 16 : Collision torque 

Further, the above-indicated kinetic friction torque x \x 1 5 can be calculated by the 
following Numerical Expression 7. 
[Numerical Expression 7] 

xji = K|a x sgn, 

wherein Kn is the magnitude of kinetic friction, and 

1 (am>Q) 
sgn = <j 0 (com-O) 
- 1 (cam<0) 

Further, the collision torque xdis on the right side of the Numerical Expression 6-2 
can be obtained by the following Numerical Expression 8 which is modified on the basis of 
the Numerical Expression 6-1 and the Numerical Expression 6-2. 

[Numerical Expressions 

xdis = (Kt x Im - Jm x am - D x xnm - K\x x sgn) - xdyn 



In the abovel^mOT - Jm x am - D x mm - K|i x sgn is 

torque outputted to the reduction gear by the motor, and xdyn is kinetic torque. 

In Fig. 14, a reference numeral 30 represents the Numerical Expression 8 as a 
collision torque estimation block. 

In the collision torque estimation block 30, a kinetic torque estimation value 
xdyno 29 can be obtained by executing the inverse kinetic calculation in a kinetic torque 
calculation block 26 by means of motor velocity feedback of all shafts constituting the 
robot and mechanical parameters of the robot. The collision torque estimation block 30 
finds a collision torque estimation value xdiso 28 by means of this kinetic torque 
estimation value xdyno 29, and outputs this collision torque estimation value xdiso 28 to a 
collision judging block 31. 

The collision judging block 31 detects collision, by means of a predetermined 
collision detecting threshold xth, in accordance with the following Numerical Expression 
9. 
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described before. Therefore, it is not possible to perform the pull-up operation in advance 
in anticipation of the follow-up delay. 

Therefore, in order to lessen the pressing amount of the welding wire 1, it is 
necessary to lessen the follow-up delay of the torch velocity <fV. Further, in the welding 
5 process in the embodiment, the operating direction of the welding torch 4 from the position 
at the time TSO is only the direction separating from the base material 7, which is different 
from the case in the conventional example in which the welding torch 104 moves also to 
the base material 107 side from the position at the time TSO' as described referring to Fig, 
5. Therefore, there is no anxiety of buckling as indicated in the conventional example 
10 due to the vibration caused by the change of the velocity direction. 

Further, it is preferable that the resultant velocity of the welding torch 4 velocity 
and the welding wire 1 velocity is constant. Therefore, it is good to adjust the velocity 
follow-up error so as to be minimized. 

On the other hand, regarding the usual operation and positioning of the robot 
15 manipulator 9, the welding torch 4 located in a retreat position at the time TSO in order to 
supply the base material 7 is moved in a weld start position by driving the robot 
manipulator 9 by the robot controller 10. 

At this time, it is preferable that the leading end of the welding wire 1 stops 
without overshooting to the base material 7 side. This is because there is fear that the 
20 overshoot of the leading end of the welding wire 1 will cause the contact of the leading end 
of the welding wire 1 with the base material 7 at the unintentional point of time. 

However, since the movement of the welding torch 4 in the welding direction after 
the TS4requires locus accuracy, that is, follow-up characteristic, it is preferable to increase 
the FF gain within an allowable value of the overshoot. 
25 Next, a position control loop in the embodiment, which is constructed in the robot 

controller 10, will be described. 

Fig. 1 is a block diagram showing a position control loop constructed in the robot 
controller 10. In Fig. 1, the same components as those in Figs. 6 and 9 are denoted by the 
same reference numerals. 
30 The position control loop shown in Fig. 1 is constructed by adding, to the position 

control loop in the conventional example described referring to Fig. 9, a torch separation 
control block 224 for improving responsibility of only the torch pull-up operation in the arc 
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